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(54) Apparatus arKi method for tracking a vehide 

(57) An apparatus and metliod for tracking a vehicle 
is provided. The vehicle tracking system may include an 
inertia! measurement unit for providing inertia! vehicle 
state characteristics of the vehicle. The inertia! meas- 
urement unit may Include at least one gyro and at least 
one accelerometer The vehicle tracking system addi- 
tionally includes an inertia! converter for generating 
vehicle state information from the inertia! vehicle state 
characteristics. Clinometers are utilized within the vehi- 
cle tracking system to initialize the gyros and may addi- 
tionally provide acceleration Information. The vehicle 
tracking system may additionally include one or more 
redundant sensors for providing redundant state infor- 
mation. The redundant sensors can include an odome- 
ter/tachometer, Global Positioning System receiver, tag 
receiver, and a map matching system. A Kalman filter 
may be utilized to reduce error within the vehicle track- 
ing system and improve the accuracy thereof. 
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Description 

BACKGROUND OF THE INVENTtON 

This irrverrtion relates generally to the tracking of 
vehicle motion, and more particularly, to the utilization of 
redundant vehicle state Information and clinometers to 
provide accurate measurements of the vehicle state in 
real time. 

The Interest in the tracking of land vehicles has 
recently increased dramatically. Vehicle tracking is an 
applied science which utilizes a variety of techniques 
and approaches to determine vehicle state information. 
The vehicle state information may Include present posi- 
tion, velocity, acceleration as well as attitude informa- 
tion. 

For centuries, the position and course of ships were 
determined by celestial ot)servations and compass 
readings. Subsequently, similar technology was utilized 
for aircraft navigation. More recently, radio location sys- 
tems, inertial measurement systems (IMS), and Global 
Positioning Systems (OPS) have been utilized to assist 
with the tracking and navigation of vehicles. In addition, 
map matching has also been introduced to reduce time 
based en-or in vehicle tracking and navigation systems. 

Vehicle tracking and navigation systems provide an 
abundance of useful information related to the vehicle 
state. This information may be utilized by the driver for 
planning the best possible route to reach a part'icutar 
destination and may Include distance and direction 
information as well as detailed guidance instructions. 

Additionally, the vehicle tracking systems may be 
utilized in a fleet management system wherein a central 
control facility remotely monitors the status of individual 
vehicles. Typical applk^ations Include bus schedule con- 
trol, police car dispatching, and emergency car dis- 
patching. Location and status data may be transmitted 
between the plurality of vehicles and the central control 
facility via radio communk^ation. 

Inertial measurement units or guidance systems 
were developed in Germany during the Second World 
War. These initial inertial systems were generally uti- 
lized for determining desired flight attitude in aircraft and 
measuring acceleratkni or thrust abng a longitudinal 
axis. 

More recently, Inertial measurement units have 
been utilized to assist with the tracking and navigation of 
land vehicles. Specifically, inertial measurement units 
can monitor the acceleration vector of a land vehicle in 
motion. The inertial measurement units generally con- 
sist of various combinations of Inertia! sensors Including 
one to three gyros and one to three accelerometers. 
Additional sensors may be utilized to provide fault toler- 
ant operation. 

The gyros used in the inertial measurement unit 
measure the angular velocity of the vehicle w'rth respect 
. to inertia! space and the accelerometers measure the 
linear acceleration of the vehicle. The angular orienta- 
tion of the vehicle may be obtained by integrating the 



output of the gyros with respect to time. The linear 
velocity and position of the vehicle m^ be obtained by 
integrating the accelerometer output with respect to 
time and performing appropriate coordinate transforma- 
5 tions. 

Some tracking subsystems such as dead reckoning 
or inertial measurement systems inherently accumulate 
error over time. While this error may be reduced through 
various error collapsing schemes, the accuracy of the 

10 entire vehtele tracking system will be drastically 
Improved if the error is minimized before the vehicle 
begins to move. 

Other errors may arise In the vehicle tracking sub- 
systems due to noise in the tracking instruments, 

IS processing limitations and errors in the map database if 
map matching Is utilized. Therefore, the accuracy of the 
vehicle tracking system is greatly improved if an 
increased amount of vehicle state information, Including 
redundant vehicle state information, Is utilized by the 

20 vehicle tracking system. 

SUMMARY OF THE INVENTION 

This invention provides for a vehicle tracking sys- 
25 tem which preferably utilizes redundant sensor integra- 
tion for providing error reduction and accurate vehicle 
state information. In addition, the vehicle tracking sys- 
tem utilizes clinometers for increasing the accuracy of 
the vehicle tracking system during the initial stages of 
30 vehicle movement. 

In particular, the vehicle tracking system in accord- 
ance with the present invention includes an inertial 
measurement unit which includes one or more gyros 
and one or more accelerometers for providing Inertial 
35 State characteristics of the vehicle. The vehicle tracking 
system additionally includes an inertial converter cou- 
pled with the inertia! measurement unit for obtaining 
vehicle state information from the inertial state charac- 
teristics. One or more clinometers are inrplemented in 
40 the vehicle tracking system for Initializing the gyros and 
providing vehicle acceleration Information. 

The vehicle tracking system preferably Includes a 
plurality of redundant sensors coupled with the fitter for 
providing redundant vehk^le state information. The 
45 redundant sensors can include wheel rotation sensors 
such as an odometer or tachometer, a Global Position- 
ing System receiver, a tag receiver or a map matching 
system. The vehicle tracking system preferably includes 
a recursive estimation filter coupled with the inertial 
50 converter and redundant sensors for removing noise 
from the vehicle state Information and outputting cor- 
rected vehicle state information. 

mmr pescwiPTiON of th e PBAwiwes 

55 

Figure 1 is a functional block diagram of a vehicle 
tracking system and a fleet management system; 

Rgure 2 is a functional block diagram of a vehicle 
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tracking system in accordance with the present 
invention; and 

Figure 3 is a diagram of a vehicle travelling on a 
routa 

DESCRIPTION OF THE PREFERRED EMBODI- 
MENTS 

The vehicle tracking system according to the 
present invention provides an apparatus and a method 
for determining vehicle state information including posi- 
tion, velocity, acceleration, and attitude. 

As shown in Figure 1, the vehicle 10 is equipped 
with a plurality of sensors and a processor 48 for obtain- 
ing vehicle state information. The vehicle state informa- 
tion may be utilized on board the vehicle 1 0 to Inform the 
driver, via a user Interface 20, of present position, veloc- 
ity and acceleration as well as attitude information. 

Alternatively, the vehicle 10 may include a first 
transceiver 22 for transmitting the vehicle state informa- 
tion to a second transceiver 24 and a fleet management 
system 40 for remote monitoring of the vehicle 10. The 
vehicle state information may be utilized by the fleet 
management system 40 to coordinate the dispatching 
of the vehicles 10 or monitor public transportation vehi- 
cles 10. 

The vehk^le tracking system preferably includes an 
inertlal measurement unit 26 for providing vehicle state 
information including position, velocity, acceleration and 
attitude of the vehicle 10. The inertial measurement unit 
26 can include a plurality of inertial sensors including 
one or more gyros and one or more accelerometers. 

Preferably, the inertial measurement unit 26 con- 
sists of a full set of strapdown inertial instruments 
including three orthogonally oriented gyros and three 
orthogonally oriented accelerometers. However, the 
inertial measurement unit 26 provides accurate vehicle 
state characteristics with three orthogonally oriented 
gyros and a single accelerometer aligned with the mean 
direction of the linear vehicle velocity vector. 

The accelerometer of the inertial measurement unit 
26 provides the linear velocity of the vehicle 1 0 while the 
gyros provide angular rotational rates of the vehicle. 
The gyros are preferably oriented to provide attitude 
information including roll, pitch and heading of the vehi- 
cle 10. The vehicle state diaracteristics from the inertial 
measurement unit 26 may thereafter be forwarded to an 
inertial converter 27 as shown In Figure 2. 

The Inertial converter 27 may be organized into a 
veloctty module and an attitude module. The velocity 
module of the inertial converter 27 may obtain velocity 
infornr^tion of the vehicle 10 by integrating the acceler- 
ometer output with respect to time. Further, the position 
of the vehicle 10 may be approximated by integrating 
the velocity infonmation with respect to time. 

The attitude module may integrate the rotational 
rate measured by each gyro to provide an instantane- 
ous angular orientation of the vehicle 10. However, the 



initial orientation of the vehicle must be known in order 
fo obtain accurate infdrmatlon from the gyros. 

Therefore, the vehicle tracking system may include 
one or nrore clinometers 28 for initializing the gyros, and 

5 additionally providing vehicle state information. Operat- 
ing in a static mode, the clinometers 28 measure the 
angle between the gravity vector and an axis of orienta- 
tion of the clinometer 28. Preferably, two clinometers 28 
are utilized by the vehicle tracking system for measuring 

TO the roll and pitch of the vehicle 10 while the vehicle is 
not accelerating. The output of the clinometers 28 in the 
static mode may thereafter be fonwarded to the inertial 
converter 27 for initializing the roll and pitch gyros of the 
inertial measurement unit 26. 

15 The output of the clinometers 28 may additionally 
be processed during a dynamic mode wherein the vehi- 
cle Is accelerating. The clinometer output approximates 
the acceleration of the vehicle 10. 

The vehicle tracking system may additionally 

20 include a plurality of redundant sensors 30 as shown in 
Figure 2. The redundant sensors 30 obtain redundant 
vehicle state Information through a variety of methods to 
help reduce enror wItNn the vehicle tracking system. 
The redundant sensors 30 may include an absolute 

25 tracking system such as a Global Positioning System 
(GPS) 32. The vehicle can be equipped with a Gfobal 
Positioning System receiver 31 as shown In Figure 1 for 
receiving position data of the vehicle 10 from the Global 
Positioning System 32. 

30 The use of a Global Positioning System 32 is 
advantageous Inasmuch as the position data is deter- 
mined independent of previous data. Therefore, error 
within the Global Positfoning System 32 will not 
increase over a period of time. Additional sensors may 

35 be utilized within the vehicle tracking system inasmuch 
as Global Positioning Systems 32 are limited by line-of- 
sight coverage, weather conditions and terrain charac- 
teristics. 

The vehicle tracking system may therefore include 

40 a map matching system for providing continuous correc- 
tion of the heading and position of the vehicle 10 when 
recognizable road features are identified. An example of 
a map matching system for collapsing error within the 
vehicle tracking system is disclosed in the Applicant's 

45 United States Patent Application Serial NunrU^er 
08/518,639, filed August 24, 1995. which is entitled 
"Map Matching Navigation System". 

The map matching system may include a map data- 
base 34 and a map matching module 46 as shown in 

so Figure 2. Map matching systems depend on an accu- 
rate map database 34 in order to provide reliable and 
useful vehicle state Information. Therefore, the map 
database 34 is preferably generated from numerous 
sources to eliminate obsolete or inaccurate data. 

55 The operation of a map matching system is shown 
with reference to Figure 3. In particular, the inertial 
measurement unit 26 obtains vehicle state characteris- 
tics as the vehicle 10 travels on a vehicle route 47. The 
vehicle state characteristics are fonwarded to the inertial 
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converter 27 to provide vehicle state information. This 
vehicle state information may include position informa- 
tion defined as a plurality of measured points 42. The 
measured points 42 may vary from a map route 44 as 
shown in Figure 3 due to approximation error, map data- s 
base en-or. digitization error and the like. 

The map matching module 46 is configured to 
match each measured point 42 to a matched point 43 
on the map route 44, The matched points 43 corre- 
spond to the measured points 42 and are the most prob- io 
able locations of the vehicle 10 on the map route 44. 
Furthermore, the position of the vehicle 10 may be 
updated on the map route 44 at a plurality of positions 
wherein the location of the vehicle 10 is known with a 
high level of confidence. These locations may include is 
the end of curves in the map route 44 and recognizable 
road features. 

The map matching module 46 may additionally be 
utilized to update heading information of the vehicle 10 
with information stored within the map database 34 at 20 
positions on the map route 44 wherein the confidence 
level of the vehicle position is high. 

The vehicle tracking system may further Include a 
plurality of tags 45 or proximity beacons located at a 
plurality of positions adjacent the vehicle route 47. The 25 
tags 45 may be passive tags which transmit information 
in response to an intenrogation signal from the vehicle 
10 as the vehicle 10 passes each Individual tag 45. The 
tags 45 can be transponders. 

Each tag 45 may transmit information including 30 
position, velocity, route bcation, route identification, tag 
nuntber and the like. The vehicle 10 is preferably 
equipped with a tag receiver 36 for receiving the trans- 
mitted vehicle state information from the tag 45 for 
reducing the error within the vehicle tracking system. 35 
The tag receiver 36 can be a transponder read device. 

The vehicle tracking system may alternatively 
include a plurality of tags 45 whteh are infrared beacons 
positioned adjacent the vehicle routes 47. The tag 
receiver 36 would therefore include an infrared receiver 40 
for receiving the tag information. 

The redundant sensors 30 of the vehicle tracking 
system may further include a sensor such as an odom- 
eter/tachometer 38 for measuring the rotation of a 
wheel of the vehicle 10. The odometer counts the 45 
number of rotations of a wheel of the vehicle 10 and 
may therefore provide distance information as the vehi- 
cle 10 travels on the vehicle route 47. The tachometer 
additionally counts the number of rotations over a spec- 
ified period of time and may provide velocity lnformatk>n 50 
of the vehicle 10. 

Each redundant sensor 30 may introduce error into 
the vehk^le tracking system (e.g. error in odome- 
terAachometer data due to vehicle wheel slippage). 
Therefore, the vehicle tracking system preferably ss 
includes a recursive estimation filter for removing error 
from the vehicle state information provided by the Glo- 
bal Positioning System 32, map database 34, tag 
receiver 36. odometerVtachometer 38. inertial measure- 



ment unit 26, and inertial converter 27. The clinometers 
28 may additionally provkle vehicle state Information to 
the Kalman filter 50 during vehicle acceleration. The 
recursive estimation filter can be a Kalman filter 50. 

The vehicle state information from the inertial 
measurement unit 26 and the redundant sensors 30 
noay be applied to the Kalman filter 50 as shown in Fig- 
ure 2. The Kalman flHer 50 utilizes the vehicle state 
information in order to estimate sources of error within 
the vehicle tracking system. In effect, the Kalman filter 
50 uses each new vehicle state observation to update a 
probability distribution for the state of the vehicle. The 
Kalman filter 50 is additionally efficient in operatbn 
inasmuch as the filter does not refer back to previous 
observations of the vehide state. Accordingly, the 
Kalman fitter 50 is tailored to real-time applications for 
providing on the spot declsbn making. 

As previously described, the Kalman filter 50 may 
collapse or reduce error within the vehicle tracking sys- 
tem through the processing of vehicle state information 
from the redundant sensors, inertial measurement unit 
26. and inertial converter 27. Furthermore, the Kalman 
filter 50 is preferably configured to assign independent 
weights to the vehicle state information provkJed from 
each source depending upon the level of confidence in 
the accuracy of the source. 

As shown In Figure 2. the Kalman filter 50 inte- 
grates the vehicle state information from the inertial 
converter 27 and each redundant sensor 30 and pro- 
vides an output 52 of corrected position, velocity and 
attitude information. In addition, the Kalman filter 50 
may feedback biases of the inertia! measurement unit 
26 to correct future output from the Inertial converter 27. 
The output 52 of the Kalman filter 50 may additionally 
be applied to the map matching module 46 which may 
be utilized for determining the matched points 43. The 
matched points 43 may thereafter be applied to the 
Kalman filter 50 for Integration wHh the vehicle state 
Informatton. 

The matched points 43 may additbnally be applied 
to the user Interface 20 for displaying the approximate 
location of the vehicle 10 on the map route 44 or to the 
transceivers 22, 24 and the fleet management system 
40 for remote monitoring. The conrected positton, vek>c- 
ity and attitude inforn^tlon from the Kalman filter 50 
may additionally be applied to the user interface 20 or 
the transceivers 22. 24 and the fleet management sys- 
tem 40. 

The Kalman filter 50 and the map matching module 
46 and the inertial converter 27 may be Implemented in 
a processor 48 for flexibility. 

While specific embodiments of the invention have 
been described in detail, it will be appreciated by those 
skilled In the art that various modlficatbns and alterna- 
tives to those details couki be developed in light of the 
overall teachings of the discbsure. Accordingly, the par- 
ticular arrangements disclosed are meant to be illustra- 
tive only and not limiting to the scope of the inventbn 
which is to be given the full breadth of the following 
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claims and all equivalents thereof. clinometer is coupled wHh said filter to apply 

dynamic vehicle state information thereto. 

Claims 

10. The apparatus of claim 7 wherein the inertial sen- 
1. An apparatus to obtain vehicle state information, s sors include at least one gyro and at least one 
comprising: acceleronieter. 



a. an inertial measurement unit including a plu- 
rality of inertial sensors to provide a plurality of 
vehicle state characteristics; 

b. an inertial converter coupled with said iner- 
tia! measurement unit to derive inertial vehicle 
state information from the vehicle state charac- 
teristics; 

c. a fitter coupled with said inertial converter to 
remove error from the inertial vehicle state 
information and outputting corrected vehicle 
state information; and 

d. at least one clinometer coupled with said 
inertial converter to initialize the vehide state 
characteristics. 

2. The apparatus of claim 1 wherein said at least one 
clinometer is coupled with said filter to apply 
dynamic vehicle state information thereto. 

3. The apparatus of claim 1 wherein the inertial sen- 
sors include at least one gyro and at least one 
acceferometer. 

4. The apparatus of claim 3 wherein said at least one 
clinometer initializes a pitch gyro and a roll gyro 
when the acceleration of the vehicle is zero. 

5. The apparatus of claim 4 wherein said at least one 
clinometer is coupled with said filter to apply 
dynamic vehicle state information thereta 

6. The apparatus of claim 1 further comprising a plu- 
rality of redundant sensors coupled with said filter 
to provide redundant vehicle state information. 

7. The apparatus of claim 6 wherein said redundant 
sensors include a wheel rotation sensor to provide 
velocity and distance information, a global position- 
ing system to provide position information, a tag 
receiver and a plurality of physical tags to provide 
position and velocity information, and a map notch- 
ing database and a map matching module to pro- 
vide position and attitude information. 

8. The apparatus of claim 7 wherein said inertial con- 
verter, said filter, and said map matching module 
are implemented in a processor. 

9. The apparatus of claim 7 wherein said at least one 



11. The apparatus of daim 10 wherein said at least one. 
clinometer initializes a pitch gyro and a roll gyro 

10 when the acceleration of the vehicle is zero, 

12. The apparatus of claim 1 1 wherein said at least one 
clinometer is coupled with said filter to apply 
dynamic vehicle state information thereto. 

15 

13. The apparatus of claim 9 wherein said filter applies 
corrected vehicle state informatfon to said inertial 
converter to update the derived vehicle state infor- 
mation therein. 

20 

14. The apparatus of claim 13 wherein said filter Is a 
Kalman filter. 

15. The apparatus of claim 14 wherein said inertial 
25 measurement unit includes three orthogonal gyros 

and one accelerometer. 

1 6. The apparatus of claim 1 5 further conprising a user 
interface to display corrected vehicle state informa- 

30 tion. 

1 7. The apparatus of claim 1 6 further conprising a fleet 
management system to receive and monitoring the 
corrected vehicle state information. 

35 

18. A method to determine vehicle state information, 
comprising the steps of: 

a. initializing at least one inertial sensor; 

40 

b. extracting inertial vehicle state information 
from at least one inertial sensor; 

c. obtaining redundant vehicle state informa- 
45 tion from at least one redundant sensor; 

d. filtering the inertial vehicle state information 
and the redundant vehicle state information to 
reduce error therein; and 

so 

e. determining corrected vehicle state informa- 
tion from the inertial vehicle state information 
and the redundant vehicle state information. 

65 19. The method of claim 1 8 further comprising the step 
of updating the position and heading of the vehicle 
in a map matching system. 

20. The method of claim 18 wherein the at least one 
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inertia! sensor includes three ortliogonal gyro- 
scopes and an accelerometer. 

21: The method of claim 20 wherein said initializing is 
performed by a clinometer. 5 

22. The method of claim 21 further comprising the step 
of updating the position and heading of the vehicle 
In a map matching system. 

10 

23. The method of claim 21 wherein said initializing is 
performed when the acceleration of the vettide is 
zero. 

24. The method of claim 1 8 wherein at least one redun- is 
dant sensor includes a wheel rotation sensor to pro- 
vide velocity and distance information, a global 
positioning system to provide position information, 

a tag receiver and a plurality of tags to provide posi- 
tion and velocity information, and a map matching so 
system to provide position and attitude information. 

25. The method of claim 24 further comprising the step 
of updating the position and heading of the vehicle 

in a map matching system. 25 

26. The method of claim 25 wherein the at least one 
inertial sensor includes three orthogonal gyro- 
scopes and an accelerometer, 

30 

27. The method of claim 26 wherein said initializing is 
performed by a clinometer. 

28. The method of claim 27 wherein the inertial vehicle 
state information Is extracted from the at least one 3S 
inertial sensor and the filter. 
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